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Abstract  -  Many  wireless  sensor  networks  (WSN)  use  time 
of  arrival  (TOA)  based  ranging  to  localize  and  track  the 
nodes  in  the  network.  In  non-multipath  environments  the 
channel  impulse  response  (CIR)  will  exhibit  a  single  peak , 
which  corresponds  to  the  direct  line-of-sight  (LoS)  path.  In 
multipath  environments,  however,  the  CIR  will  often  contain 
multiple  peaks,  and  it  is  not  known  which  peak,  if  any,  is  due 
to  the  direct  LoS  path.  This  problem  is  similar  to  the  data 
association  problem  faced  by  many  target  tracking  systems. 
Inspired  by  this  observation,  a  new  algorithm  is  presented 
in  this  paper  for  target  tracking  in  multipath  environments. 
The  proposed  algorithm  is  based  on  the  multidimensional 
assignment  formulation  for  data  association.  Through  sim¬ 
ulations  the  effectiveness  of  the  proposed  algorithm  is  con¬ 
firmed. 

Keywords:  Wireless  sensor  networks,  localization  and 
tracking  algorithms,  data  association,  multidimensional  as¬ 
signment. 

1  Introduction 

Accurate  localization  and  tracking  of  nodes  is  an  impor¬ 
tant  requirement  in  many  emerging  wireless  sensor  network 
(WSN)  applications  [13].  Existing  localization  technologies 
such  as  global  positioning  system  (GPS)  [6]  are  suitable  for 
some  WSN  applications,  however,  their  accuracy  and  oper¬ 
ating  conditions  (GPS  works  well  only  in  outdoors)  are  in¬ 
sufficient  for  many  other  applications.  Hence,  development 
of  new  localization  and  tracking  technologies  is  required. 

At  the  Commonwealth  Scientific  and  Industrial  Research 
Organization  (CSIRO)  a  wireless  sensor  network  (WSN) 
platform,  the  WASP  (Wireless  Ad  Hoc  System  for  Position¬ 
ing),  is  currently  under  development.  This  platform  is  be¬ 
ing  evaluated  for  use  in  applications  such  as  assisting  emer¬ 
gency  first  responders,  tracking  athletes  for  performance 
monitoring,  and  automation  in  the  mining  industry. 

The  WASP  platform  uses  ranging  between  pairs  of  nodes 
for  localization  and  tracking.  Received  signal  strength  is  the 
simplest  and  lowest  cost  metric  for  ranging,  however,  the 


resulting  accuracy  is  not  adequate  for  high  precision  track¬ 
ing  [5].  Ranging  based  on  the  estimation  of  the  time  of  ar¬ 
rival  (TOA)  of  the  received  signal  can  result  in  more  accu¬ 
rate  range  estimates.  Accurate  and  robust  TOA  estimation, 
especially  in  severe  multipath  conditions,  however,  is  a  chal¬ 
lenging  task  [10]. 

TOA  estimation  systems  rely  on  the  channel  impulse  re¬ 
sponse  (CIR)  and  estimate  the  TOA  as  the  first  detected  peak 
or  by  analyzing  the  slope  of  the  leading  edge.  Several  fac¬ 
tors  can  cause  the  first  peak  not  to  correspond  to  the  direct 
line-of-sight  (LoS)  path  [10].  In  environments  where  there 
is  a  single  radio  path  between  the  transmitter  and  the  re¬ 
ceiver,  such  as  an  open  field,  the  CIR  will  show  a  single 
peak  that  corresponds  to  the  LoS  path.  In  multipath  envi¬ 
ronments,  however,  due  to  several  closely  arriving  pulses 
the  CIR  will  exhibit  several  peaks  and  the  peak  correspond¬ 
ing  to  the  LoS  will  be  shifted  or  lost.  It  is  also  possible 
that  the  strength  of  the  direct  path  will  be  well  below  the 
detection  threshold  due  to  complete  obstruction  of  the  path 
(by  for  example,  a  metal  object),  a  strong  scatterer  near  the 
transmitter,  or  measurement  noise. 

Several  algorithms  have  been  proposed  for  increasing  the 
TOA  estimation  accuracy.  For  example,  increasing  the  sys¬ 
tem  bandwidth  (ultra  wideband  systems)  narrows  the  pulses 
arriving  from  different  paths  and  hence,  provides  better  res¬ 
olution  for  the  identification  of  the  direct  path.  Increasing 
the  bandwidth,  however,  does  not  improve  the  TOA  esti¬ 
mation  accuracy  in  low  signal  strength  conditions.  Besides, 
the  bandwidth  available  to  any  system  is  limited  by  regula¬ 
tory  and  hardware  restrictions.  Super-resolution  algorithms 
[9]  improves  the  accuracy  of  the  TOA  estimation  without 
requiring  an  increase  in  the  system  bandwidth.  Such  algo¬ 
rithms  are  found  to  be  computationally  expensive  and  do  not 
seem  to  increase  the  estimation  accuracy  when  tested  with 
real  data  [7] . 

There  is  no  guarantee  that  the  TOA  estimation  algorithms 
will  correctly  identify  and  report  the  arrival  time  corre¬ 
sponding  to  the  direct  path.  Therefore  it  is  necessary  to 
check  whether  a  measured  range  corresponds  to  the  direct 
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path.  Several  algorithms  proposed  to  solve  this  problem 
consider  positioning  in  cellular  networks  and  assume  that 
ranges  due  to  multipath  propagation  are  positively  biased 
(for  example,  [19]  and  references  cited  therein).  Data  col¬ 
lected  from  field  trials,  however,  suggest  that  the  CIR  can 
contain  peaks  even  before  the  LoS  peak.  These  early  peaks 
can  be  due  to  noise,  sidelobes  of  NLoS  path  signals  with 
higher  amplitude  than  the  LoS  path  signal,  or  other  signal 
processing  artifacts.  As  a  result  range  measurements  in  mul¬ 
tipath  conditions  can  be  negatively  biased  as  well  as  posi¬ 
tively  biased.  Most  of  the  algorithms  presented  in  the  liter¬ 
ature  do  not  consider  this  and  hence,  may  not  work  well  in 
practice. 

In  this  paper  a  new  algorithm  for  tracking  nodes  in  mul¬ 
tipath  environments,  which  is  inspired  by  the  observation 
that  this  problem  is  similar  to  the  well-known  data  associa¬ 
tion  problem,  is  proposed.  The  proposed  algorithm  is  based 
on  the  multidimensional  assignment  (MDA)  formulation  for 
data  association.  This  formulation  results  in  an  NP-hard 
problem  and  hence,  it  is  not  possible  to  obtain  the  optimal 
solution  using  polynomial  time  complexity  algorithms.  La- 
grangian  relaxation-based  algorithms  are  available  to  obtain 
suboptimal  solutions.  As  shown  later  in  this  paper,  how¬ 
ever,  the  algorithm  presented  for  tracking  in  multipath  en¬ 
vironments  does  not  result  in  an  NP-hard  problem,  instead 
requiring  a  simple  minimization  to  obtain  the  optimal  solu¬ 
tion. 

The  rest  of  the  paper  is  organized  as  follows.  In  Section  2 
a  brief  description  of  the  WASP  platform  and  the  problem 
considered  in  this  paper  are  explained.  Section  3  explains 
the  MDA  formulation  for  the  data  association  problem.  The 
proposed  algorithm  for  tracking  in  multipath  environments 
is  described  in  Section  4  and  the  simulation  results  are  pre¬ 
sented  in  Section  5.  Concluding  remarks  are  provided  in 
Section  6. 

2  Background 

The  objective  of  the  WASP  platform  design  is  to  develop 
a  truly  ad-hoc  WSN  platform  that  could  be  used  in  many 
different  WSN  applications  as  possible  with  very  little  cus¬ 
tomization.  This  platform  operates  in  the  industrial,  scien¬ 
tific,  and  medical  (ISM)  frequency  bands  and  uses  TOA- 
based  ranging.  Further,  it  uses  a  single  radio  for  ranging  and 
data  communication  (if  required  by  the  application).  To  re¬ 
duce  the  cost,  the  design  uses  low-cost  commodity  hardware 
and  solves  problems  such  as  radio  bandwidth  limitation  and 
lack  of  time  and  frequency  synchronization  that  arise  due  to 
the  use  of  such  hardware  using  sophisticated  signal  process¬ 
ing  techniques. 

One  consequence  of  the  design  objective  is  that  it  needs 
to  be  capable  of  operating  both  indoors  and  outdoors.  For 
example,  one  area  in  which  the  WASP  platform  has  been 
field  tested  extensively  is  tracking  athletes,  where  the  re¬ 
quirement  is  that  the  platform  must  be  capable  of  providing 
comparable  accuracy  in  both  indoor  and  outdoor  sports.  An- 
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Figure  1:  CIR  in  an  outdoor  environment  showing  a  clear 
peak  corresponding  to  the  LoS  path. 


other  application  where  WASP  is  field  tested  is  the  automa¬ 
tion  of  mining.  In  this  application  the  system  is  expected  to 
operate  underground  and  in  open  areas  seamlessly. 

2.1  Problem  formulation 

The  type  of  WSN  considered  in  this  paper  consists  of  a  num¬ 
ber  of  anchors  whose  locations  are  known,  and  it  is  required 
to  track  the  remaining  nodes  in  the  network.  It  is  assumed 
that  there  exist  direct  paths  between  the  anchors  and  the 
nodes,  and  that  the  anchors  send  the  measured  ranges  to 
a  central  location  server  where  the  tracking  is  performed. 
Such  a  setup  is  adequate,  for  example,  to  track  the  athletes. 

Although  the  applications  require  multiple  nodes  to  be 
tracked,  the  WASP  platform  does  not  face  the  data  associ¬ 
ation  problem  [2]  encountered  by  most  multitarget  tracking 
systems.  This  is  because  WASP  uses  time  division  multiple 
access  (TDMA)  to  control  the  transmission  by  nodes,  mean¬ 
ing  that  a  node  is  allowed  to  transmit  only  at  specified  time 
slots.  Hence,  the  multitarget  tracking  problem  reduces  to 
tracking  multiple  single  targets  and  in  the  rest  of  the  paper 
single  target  tracking  is  considered.  Since  the  range  mea¬ 
surements  are  synchronized  and  sent  to  a  central  location 
server  for  tracking,  the  resulting  system  is  a  Type  3  track 
initialization  and  maintenance  system  [4]. 

At  each  time  slot  in  the  TDMA  frame  anchors  receive  the 
transmission  from  the  node  that  transmits  in  this  slot  and 
each  anchor  constructs  the  CIR.  Figures  1  and  2  show  the 
sample  CIR  constructed  by  the  WASP  in  an  outdoor  and  an 
indoor  environment,  respectively.  The  outdoor  CIR  shows  a 
clear  peak  corresponding  to  the  LoS  path,  however,  there  are 
several  comparable  peaks  in  the  indoor  CIR.  It  is  not  clear 
which  peak,  if  any,  corresponds  to  the  LoS  path.  Selection 
of  the  incorrect  peak  for  TOA  estimation  could  lead  to  a 
large  range  measurement  error.  In  this  paper  it  is  assumed 
that  the  anchors  identify  all  the  peaks  (up  to  the  strongest 
peak,  since  LoS  path  cannot  occur  after  this  )  in  the  CIR  and 
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Figure  2:  CIR  in  an  indoor  environment  showing  significant 
multipath  condition. 


report  all  the  ranges  corresponding  to  these  peaks  to  the  cen¬ 
tral  location  server,  where  the  identification  of  the  LoS  path 
and  the  update  of  the  track  is  performed. 

3  Data  association 

Deciding  from  which  target,  if  any,  a  certain  measurement 
originated  is  one  of  the  most  challenging  issues  in  multitar¬ 
get  tracking  systems.  This  is  referred  to  as  the  data  associ¬ 
ation  problem  and  has  been  studied  extensively  since  [18]. 
A  number  of  algorithms  have  been  developed  to  solve  this 
problem,  which  differ  in  the  complexity  and  the  resulting 
tracking  performance.  Details  on  the  the  data  association  al¬ 
gorithms  can  be  found  in  [2]  and  the  references  cited  therein. 

A  well-known  solution  for  the  data  association  problem 
is  the  MDA  formulation  [3,  15],  which  is  a  discrete  opti¬ 
mization  formulation  of  the  problem.  This  formulation  can 
also  be  viewed  as  an  approximation  to  the  optimal  multi¬ 
ple  hypothesis  tracking  (MHT)  algorithm  [16]  in  which  the 
number  of  association  hypotheses,  however,  increases  ex¬ 
ponentially.  The  MDA  formulation  in  effect  uses  a  sliding 
window  to  keep  the  number  of  hypotheses  manageable. 

Consider  the  data  association  problem  in  Type  3  track  ini¬ 
tialization  and  maintenance  systems.  In  such  systems,  at  ev¬ 
ery  time  step  the  data  association  problem  is  solved  in  two 
steps:  1)  the  measurement-to-measurement  or  static  associ¬ 
ation  and  2)  the  measurement-to-track  or  dynamic  associa¬ 
tion.  The  static  association  groups  the  measurements  from 
different  sensors1  that  have  originated  from  the  same  target 
and  the  dynamic  association  assigns  the  grouped  (combined 
or  composite)  measurements  to  the  tracks  from  the  previ¬ 
ous  scan.  An  assignment-based  solution  [12]  formulates 
the  static  and  dynamic  associations  as  multidimensional  and 
two  dimensional  assignments  respectively. 

1  Note  that  the  terms  anchors  (prevalent  in  sensor  network  literature )  and 
sensors  (prevalent  in  target  tracking  literature)  are  used  interchangeably. 
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Figure  3:  ( 5  +  1)-D  data  association. 


In  [  17]  an  extension  to  the  above  two-step  MDA  formula¬ 
tion  for  data  association  in  Type  3  systems  is  presented.  This 
algorithm  is  still  a  MDA  formulation,  however,  it  solved  the 
data  association  problem  in  a  single  step.  This  algorithm 
forms  the  basis  for  the  proposed  tracking  algorithm  in  mul¬ 
tipath  and  is  explained  next. 

3.1  ( S  +  1)-D  assignment  algorithm  for  data 

association 

Assume  that  there  are  5  sensors  in  a  Type  3  system.  Being 
synchronous  sensors  each  returns  observations  at  specified 
time  intervals.  Let  the  number  of  measurements  returned  by 
sensor  s,  s  =  1, 2, . . . ,  5,  at  scan  k  be  ns.  Also  denote  by 
zSiB  the  individual  measurement  returned  by  sensor  s.  Note 
that  is  =  1, 2, . . . ,  ns.  Further,  assume  that  nr  tracks  are 
available  from  the  previous  scans.  The  objective  is  to  iden¬ 
tify  the  measurements  from  different  sensors  that  originated 
from  the  targets  corresponding  to  the  tracks. 

The  (,S'+ 1  )-D  scenario  is  illustrated  in  Figure  3,  where  the 
first  dimension  is  the  tracks  from  the  previous  scan  and  the 
rest  of  the  5  dimensions  are  the  lists  of  measurements  from 
the  5  sensors.  In  addition  to  the  measurements  returned  by 
each  sensor  the  measurement  dimensions  have  dummy  mea¬ 
surement  as  shown  in  Figure  3,  which  accounts  for  missed 
detection  [12]. 

In  the  ( 5  +  1)-D  assignment,  an  ( 5  +  l)-tuple  consists  of 
a  track  and  5  measurements,  at  most  one  from  each  sensor. 
The  cost  of  an  ( 5  +  l)-tuple  (p,i i,  *2, . . . ,  is),  he.,  the  cost 
of  assigning  an  5-tuple  of  measurement  (ii ,  *2 ,  -  -  - ,  is)  to 
the  track  p,  is  defined  as 


■■■is  I Xp) 

&  p(Zili2...is\p  =  0) 


(1) 


where  Xp  is  the  state  of  target  p  and  ■Z»1i2...is  = 

{ ALn  5  Z2i2 , . . . ,  zsis  }  is  the  5-tuple  of  measurements.  The 
numerator  is  the  likelihood  that  the  5-tuple  of  measurement 
originated  from  the  target  corresponding  to  track  p,  and  the 
denominator  is  the  likelihood  that  all  the  measurements  in 
the  5-tuple  are  spurious. 

The  objective  now  is  to  find  the  most  likely  set  of  (5  + 1)- 
tuples  so  that  each  measurement  is  assigned  at  most  to  one 
track  and  each  track  is  assigned  at  most  to  one  measurement 
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from  each  sensor.  This  is  formulated  as  a  generalized  MDA 
problem  given  by  [12] 
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where  ppili2.. 

,s  is  a  binary  variable  such  that 

It  is  clear  that  the  above  problem  is  similar  to  the  data  as¬ 
sociation  problem  and  the  MDA  formulation  can  be  applied 
to  solve  it.  Note  that  since  there  is  only  one  track  in  the 
first  dimension,  only  a  single  (5  +  l)-tuple  that  minimizes 
the  assignment  cost  is  required  to  be  found.  Therefore,  the 
one-to-one  correspondence  requirement  that  one  measure¬ 
ment  can  be  assigned  at  most  to  one  track  and  vice  versa  is 
eliminated.  Consequently,  the  need  for  solving  the  NP-hard 
minimization  problem  defined  in  (2)  and  (3)  is  eliminated 
and  a  simple  minimization  is  suffice.  That  is2 

min  cili2...is  (5) 

l\ ,12,-i^s 

where  the  cost  of  an  ( 5  +  l)-tuple  is  again  a  likelihood  ratio 
as  in  (1),  which  is  given  by  [17] 

cw-ia  =  -logp(r|X)+ 
s 

yiMO  -  1]  ln(l  -  Pdb  )  -  u(is)  In  (PDe  ips)  (6) 

.3=1 


{1  if  (5  +  l)-tuple  is  included 

in  the  solution  set  (4) 

0  otherwise 

The  generalized  MDA  problem  above  can  be  shown  to 
be  NP-hard  for  S'  >  3  even  under  the  assumptions  of  unity 
detection  probability  and  no  spurious  measurements  [11], 
As  a  result,  finding  the  optimal  solution  is  impractical  using 
polynomial  time  complexity  algorithms.  Therefore,  for  ap¬ 
plications  such  as  target  tracking  that  require  real-time  per¬ 
formance,  algorithms  seeking  suboptimal  solutions  in  poly¬ 
nomial  time  complexity  are  required.  One  can  find  such 
suboptimal  algorithms  in  [3,  12,  14]. 

4  Target  tracking  in  multipath 

As  mentioned  before  target  tracking  in  multipath  conditions 
is  similar  to  the  data  association  problem  described  in  the 
previous  section. 

•  Each  measurement  list  consists  of  the  ranges  corre¬ 
sponding  to  the  peaks  in  the  CIR. 


In  (6),  r  is  the  vector  [defined  in  (16)]  consisting  of  at 
most  one  range  measurement  from  each  anchor,  X  is  the 
predicted  state,  Pd  is  the  probability  with  which  the  LoS 
peak  appears  in  the  CIR  for  sensor  s,  and  i/js  is  the  density 
of  false  peaks.  u(is)  is  a  binary  variable  defined  by 


f  0  if  is  =  0 

[  1  otherwise 


(7) 


4.1  Initialization 

The  proposed  tracking  algorithm  assumes  that  the  track  has 
already  been  initialized.  To  perform  track  initialization,  the 
MDA  formulation  for  static  association  [11]  can  be  used.  In 
this  formulation,  since  there  is  no  track  information  initially, 
the  track  list  in  Figure  3  is  absent  and  with  5  anchors  one 
will  have  5-dimensional  assignment  problem.  The  cost  of 
an  5-tuple  is  defined  as  a  likelihood  ratio  as  in  (1),  however, 
since  track  information  Xp  is  not  available,  following  [11], 
it  is  replaced  by  the  maximum  likelihood  (ML)  estimate  of 
the  5-tuple.  That  is 


•  There  could  be  at  most  one  LoS  range  in  each  measure¬ 
ment  list. 


=  -  log 


v{Zi_ 


|  XMl) 


p(Z,li2...is\p  =  0) 


(8) 


•  It  is  possible  that  an  anchor  does  not  have  the  LoS  path  where 

to  the  node,  which  is  accounted  for  by  the  dummy  mea-  v  v  v , 

2  2  XML  =  argmax  p(Z.hi2...i  A) 

surement.  x 


(9) 


•  Unlike  in  the  data  association  problem  there  is  only  one 
track  in  the  track  list.  This  is  because  of  the  use  of 
TDMA  scheduling  in  WASR 

•  The  objective  is  to  find  the  LoS  measurements  from 
each  list  that  has  originated  from  the  targets  corre¬ 
sponding  to  the  tracks  in  the  track  list. 


Hence,  once  all  possible  costs  defined  in  (8)  are  found, 
since  the  single  best  hypothesis  is  required  (because  a  single 
target  being  initialized),  the  5-tuple  with  the  minimum  cost 
is  selected  and  used  to  initialize  the  track.  A  flow  chart  of 
the  proposed  algorithm  is  shown  in  Figure  4. 

-  Since  there  is  only  one  track  the  track  index  is  omitted. 
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Figure  4:  Flow  chart  of  the  proposed  tracking  algorithm  in 
multipath  conditions. 

5  Simulations 

The  performance  of  the  proposed  algorithm  is  evaluated  us¬ 
ing  simulations.  Single  target  tracking  is  assumed  since  as 
explained  before  the  WASP  platform  does  not  encounter  the 
data  association  problem.  The  scenario  considers  tracking 
a  cyclist  in  a  velodrome  as  shown  in  Figure  5.  The  anchor 
layout  was  from  one  of  the  field  trials  carried  out  in  Ade¬ 
laide,  Australia.  The  velodrome  track  and  anchor  locations 
were  obtained  through  a  field  survey. 

5.1  Scenario 


x(m) 


Figure  5:  Simulation  scenario.  The  velodrome  track  and 
nine  anchors  (shown  as  *).  The  target  trajectory  was  con¬ 
strained  within  the  velodrome  tracks. 


where  71-  =  tk  —  tk-i,  q  is  the  process  noise  intensity,  and 
I2  is  a  2  x  2  identity  matrix,  and  0  denotes  the  Kronecker 
product.  The  CT  model  is  defined  by 


Xk=FfrXk.1+  Tkvk-i  (13) 


where 


F, 


CT 
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(14) 


(15) 


The  target  is  constrained  to  move  within  the  velodrome  track 
and  the  true  trajectories  are  generated  using  nearly  constant 
velocity  (NCV)  and  coordinated  turn  (CT)  models  [1],  The 
NCV  model  is  defined  by 

Xfc  =  if' vXk_1  +  vk-i  (10) 


Note  that  while  generating  the  CT  segment  of  the  trajec¬ 
tory  the  state  is  augmented  with  the  turn  rate.  It  is,  however, 
not  tracked. 

The  LoS  measurements  identified  using  the  proposed  al¬ 
gorithm  are  collected  in  to  a  measurement  vector.  The  mea¬ 
surement  model  is  then 


where  Xk  =  [xk,xk,yk,yk]T  is  the  state  of  the  target  at 
time  tk,  Fj?v  is  the  state  transition  matrix,  and  vk-t  is 
the  zero  mean  Gaussian  process  noise  with  covariance  Qk. 
Fk'v  and  Qk  are  given  by 


rk  =  h(Xk)+wk  (16) 

where  with  S  anchors  reporting  LoS  ranges  the  measure¬ 
ment  function  h(.)  is  given  by 


Qk 


'  1  Tk' 

(ID 

'  \\HXk-0rW  ' 

0  1 

\\Hxk-e2\\ 

'  TH 2  Tk/2  ' 
.  Tk/ 2  Tk 

q 

(12) 

h{Xk)  = 

_  \\HXk-6s\\  _ 

(17) 
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where  0;  =  [xi,  t/j]T  is  the  known  location  of  sensor  i,  i  = 
1,2 ,S  and 

H  =  I2®[  1  0  ]  (18) 

Measurement  noise  in  each  anchor  is  assumed  to  be  Gaus¬ 
sian  distributed  with  zero  mean  and  variance  cr2,  s  = 
1,2  and  uncorrelated  between  the  anchors.  Conse¬ 

quently,  Wk  is  zero  mean  Gaussian  vector  with  covariance 
R  =  diag(er2,  cf, ,  <Tg). 

At  each  time  scan  the  LoS  measurement  for  sensor  s  is 
generated  with  probability  I’d  and  the  number  of  non  LoS 
(NLoS)  measurements  for  sensor  s  is  assumed  to  be  Poisson 
distributed  with  rate  As.  It  is  assumed  that  the  NLoS  mea¬ 
surements  are  uniformly  distributed  in  [rjos>s  —  rhjS,  nos>s  + 
rajS],  where  riOStS  LoS  range  between  the  target  and  sensor 
s.  Although  these  assumptions  (i.e.,  Poisson  distribution  for 
the  number  and  uniform  distribution  for  the  spatial  density 
of  false  alarms)  are  not  strictly  true  for  NLoS  measurements, 
it  is  still  used  for  simplicity. 

The  interacting  multiple  model  (IMM)  estimator  [  1]  con¬ 
sisting  of  two  filter  modules,  is  used  to  track  the  node.  The 
measurement  model  is  the  same  for  both  filters  (16),  and 
both  filters  used  the  NCV  model  for  target  dynamics,  how¬ 
ever,  with  different  noise  intensity  levels.  Although  the 
process  model  is  linear,  the  measurement  model  described 
above  is  nonlinear,  and  hence  a  nonlinear  filter  is  required. 
The  unscented  Kalman  filter  (UKF)  [8]  is  chosen  as  the  con¬ 
stituent  filter  in  the  IMM  estimator. 

The  proposed  algorithm  is  compared  against  an  algorithm 
that  assumes  the  first  peak  in  the  CIR  as  the  TOA.  For  track¬ 
ing  the  node  the  latter  algorithm  used  the  same  IMM  frame¬ 
work  as  the  proposed  algorithm.  The  smallest  range  that 
each  anchor  reported  is  used  to  update  the  track. 


x(m) 


Figure  6:  Estimation  performance  of  the  proposed  and  first 
peak  algorithms  on  a  sample  run. 


5.2  Results 

In  this  particular  simulation  the  following  parameters  are 
used  for  all  sensors:  Pds  =  0.9,  Xs  =  3,  rb,\  =  6m, 
ra, 2  =  8m,  and  as  =  0.3m.  The  sampling  period  is  as¬ 
sumed  to  be  Is.  The  noise  intensity  level  of  the  two  NCV 
models  used  in  the  tracker  is  0.5  and  5m2/s3,  respectively. 
The  following  mode  transition  probability  matrix  is  used  in 
the  IMM  estimator. 


0.90  0.10 
0.15  0.85 


(19) 


The  estimation  performance  of  the  proposed  and  first 
peak  algorithms  along  with  the  ground  truth  for  a  sample  run 
is  shown  in  Figure  6.  It  is  clearly  evident  that  the  procedure 
to  identify  the  LoS  peak  improves  the  tracking  performance. 

In  100  Monte  Carlo  runs  the  proposed  algorithm  identi¬ 
fied  the  LoS  peak  with  83.3%  success  rate.  Note  that  if  the 
LoS  was  not  detected  at  an  anchor  and  the  proposed  algo¬ 
rithm  assigned  the  track  to  the  dummy  measurement  of  that 
anchor  it  was  also  considered  a  successful  identification. 


Figure  7:  Position  RMSE  for  the  proposed  method  and  the 
one  that  selects  first  peak  as  the  LoS  range. 


Figure  8:  Velocity  RMSE  for  the  proposed  method  and  the 
one  that  selects  first  peak  as  the  LoS  range. 
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Figure  9:  Positioning  error  pdf  for  the  proposed  and  first 
peak  algorithms. 

The  position  and  velocity  root  mean  squared  error 
(RMSE)  performance  of  the  two  algorithms  is  shown  in  Fig¬ 
ures  7  and  8  respectively.  As  seen  from  the  figure,  the  posi¬ 
tion  and  velocity  RMSE  are  nearly  halved  by  the  proposed 
algorithm. 

The  error  probability  density  function  is  shown  in  Fig¬ 
ure  9,  which  provides  some  insight  about  the  spread  of  the 
positioning  error.  It  can  be  easily  seen  that  most  of  the  prob¬ 
ability  mass  of  the  positioning  error  is  less  than  lm  for  the 
proposed  algorithm,  which  is  not  the  case  for  the  first  peak 
algorithm.  In  fact  for  the  proposed  algorithm  the  probabil¬ 
ity  mass  inside  the  lm  error  is  0.94,  while  that  for  the  first 
peak  algorithm  is  just  0.08.  The  maximum  positioning  error 
observed  for  both  the  algorithms  is  similar:  6.96m  for  the 
proposed  algorithm  and  7.32m  for  the  first  peak  algorithm. 

6  Conclusions 

In  this  paper  an  algorithm  for  target  tracking  in  the  multi- 
path  conditions  was  presented.  The  algorithm  was  inspired 
by  the  observation  that  the  problem  at  hand  is  similar  to  the 
multitarget  data  association  problem.  In  particular,  the  pro¬ 
posed  algorithm  used  the  MDA  formulation  for  data  asso¬ 
ciation  in  Type  3  track  initialization  and  maintenance  sys¬ 
tems,  however,  as  shown  in  the  paper  it  did  not  result  in  an 
NP-hard  problem.  The  solution  was  a  simple  unconstrained 
minimization. 

The  proposed  algorithm  was  evaluated  using  simulations 
and  gave  a  positioning  error  of  less  than  lm  with  a  proba¬ 
bility  of  0.94.  Corresponding  figure  for  an  algorithm  that 
assumes  the  first  peak  in  the  CIR  as  the  LoS  measurement 
was  0.08.  Currently  work  is  in  progress  to  compare  the  pro¬ 
posed  algorithm  with  other  NLoS  mitigation  algorithms  and 
also  to  test  it  using  data  collected  in  real  multipath  environ¬ 
ments  using  the  WASP  platform. 
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